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Fig 2 
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aquire wheel revolution daia 
since last Interrupt for each 
wheal LF«left front 
RF "right front 
LR « left rear 
RR=right rear 



-YES 



CafMode^TRUE 
KDlAQaKDlAG2» 
Kdca! 
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calculate wheel 
slippage 
sHp1«ABS(LF-LR) 
slip2=ABS(RF-RR) 




rajaet data U 
wheals slipping 
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YES 



accumulate and 
calculate calibration 
when caimoda is 
selected 



01»ABS<olaUalaral raUo) 
D2*ABS(olong-iongltudinal ralio) 
D3=ABS(odiag3-diag ralio 3) 
TireAlert=OFF 





accumulate wheel revolutions 






LFTeLFT+LF 






RFT«RFT+RF 






LRT«LRT+LR 






RRTsRRT+RR 






dist=LFT+RFT+LRT+RRT 
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YES 




calculate short distance stability cheeks 

spaed = fen fdiat,tima) 
lurn radius = fcn<LRT-RRTi 
lateral accal nfcn(apaod,lurn radius) 
aceol= fon^spaad.tlma) 
diagonal ratio « (LFT+RRT)/dlst 
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—NO- 



YES 

JL .'. 

A1«lataral ratio 
A2«longitudinal ratio 
A3=dlag ratio 3 
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av/arage ratios, to croato 
calibrations 



.calcntecalcnl+l 
A1=(A1f lateral ratlo)/2 
A2a{A2+longltudlnal raUoJ/2 
A3«(Aa»jdlag>ratlo 2)/2 
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initialize and store calibrations 



LalCal=A1 
LongCal=A2 
DiagRun«AugDiagaDiagCal»A3 
TiraAlart*Off * 
CaiModoopaisa 
IntcnraQ, longont-Q.oaicn^Q 
KDAIG=Kd1, KDtAG2=Kd2 
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/End, u/ait fornaidN 
I time period J 
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check far any 

conditions 
requiring data 
to be rejected 

YES' 



-YES- 



-YES 




•YES 



•YES 




NO 
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accumulate short distances 
to form mid distance 




* LFA-LFA+LFT 
RFA+RFA+RFT 
LRA=LRA+LRT 
RRA-RRA+RRT 
dls 1= LFA+RFA+ L RA+RRA 
LFTeQ 




RFT-0 
LRT=0 
RRT=0 
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determine if mid distance 
has been accumulated 



is disi > KMIDD 




NO- 
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.YES. . 
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calculate mid distance stability checks 

odiag=diagonal ratio 2 
speed " -fen (disl.lime) 
turn radius « fcn(LRA-RRA) 
lateral accsl =fcn<speed.tum radius) 
eccal« fcn(spaed t time) 
Speedad]=spaed*ICSPEED 
longitudinal ratlo«(LFA+RFA)/dlsl 
dlag .ratio •2«(LFA+RRA)/dist 
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is ABS(langltudlnaT\ 
radoi-spesdadj) 
>KGRAVEL 



If vehicle a pears to be on 
grave! , require additional 
data checks 



-NO- 



NO 



reset short distance and mid dtatanca 
accumulators 

LFA=LFA fc Ok ( RFAhRFA OK 
LRA=LRA_OK, RRA=RRaToK 
LFT=Q.RFT a 0,LRT=*0,RRT B Q 
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accumulate mid distances lo form long 
distance 

LFB=LFS+LFA 
RFS+RFS+RFA 
LRS e LRS+LRA 
RRSaRRS+RRA 
disr=LFS+RFS+LRS+RRS 
LFAaO.RFA-O.LRAsQ.RRAaO 
AvgAecal=»AugAccel+accalaration 
AvgLataAvgLai+lataral acceleration 
AvgSpeod=AvgSpeedi speed 
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check If detection 
distance has been 
accumulated 




calculate Jang distance stability checks 



olong=longitudtnal ratio 
olaielaierai ratio 
odiag3-diag ratio3 
longitudinal ratio=(LFS+RFS)/dist 
dlag rallo 3=(LFS+RRS)/disi 
lateral ratio* (LFS+LRS)/dist 
LFS«O.RFS«Q.LRS«O.RRS«0 



210 



i 
j 

update diagonal; 

ratio average } 
whenever date H 
repeatable and j 
vehicle Is not j 
maneuvering 




check for tow tire 



Compa (DlagCai-Avg Dlag) 
AccaladJ-AvgAccel * Comp / 1 Caeca d] 
Latadj-AvgLat *Comp / KJetadj 




DlagRun B (DiagRurw-dlog ratio 3)72 
loss»ABS(DlagRurvDla0Cal+Accelad)+LatadJ) 
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.atadj) _j 
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DiegRun=(DiagRun+ AvgDiag)/2 
lass=ABS(DlagRun-DtegCal) 
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NO 



^t^ABS(DiagRun 
'«NO <^ AvgDlag)< 

Kataady7 - y 





-W a V is ABSfDtagRun- 
* NU ^xD»agCal) < Ktrtpoff 




TlraAlert=OFF j 



0 



F; 



3 



